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FIG.IO 



INITIALIZATION (t=0, ETC.) [ 



3- 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE). 



IS GAIT 
CHANGING? 



READ NEXT TIME GAIT SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE. 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETER OF NORMAL GAIT 



SUBROUTINE FOR DETERMINING INITIAL STATE 

(INITIAL DIVERGENCE COMPONENT, ETC.)OF NORMAL GAIT 



PROVISIONALLY DETERMINE GAIT PARAMETER OF CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETER 
(CORRECT CURRENT TIME GAIT PARAMETER SUCH THAT DIVERGENCE 
COMPONENT AT END OF CURRENT TIME GAIT AGREES WITH INITIAL 
DIVERGENCE COMPONENT OF NORMAL TURNINGS) frA IT 



V 



DETERMINE PARAMETERS OF ZMP PERMISSIBLE RANGE AND FLOOR 
REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE 
FOR FULL-MODEL CORRECTION. 



SUBROUTINE FOR DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE 



DETERMINE ARM SWINGING OPERATION TO CANCEL SPIN FORCE 



DETERMINE INSTANTANEOUS VALUES OF ZMP PERMISSIBLE RANGE AND FLOOR REACTION 
FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 



GEN ERATE CORRECTED GAIT USING FULL MODEL. | 
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FIG.12 



DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) OF FOOT POSITION/POSTURE BODY 
POSTURE ANGLE e bs, AND ARM POSTURES ON THE BASIS OF NORMAL TURNING GAIT PARAMETER. 



PROVISIONALLY DETERMINE INITIAL (AT Ts) BODY HORIZONTAL POSITION, VELOCITY 
ANGULAR VELOCITY, AND BODY INCUNATION RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE 
CANDIDATES (Xs, Vxs, gjbs, ZMPrei 
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V 



DETERMINE INITIAL BODY VERTICAL POSITION/VELOCITY (Zs, Vzs). 



USING DYNAMIC MODEL, GENERATE GAIT FOR ONE STEP ON THE BASIS OF NORMAL 
TURNING GAIT PARAMETER INCLUDING ZMPrecpeek, TAKING 0 bs, (Xs Vxs wbs) 
(Zs,Vzs) AS INITIAL STATES OF BODY. ' ' 



CONVERT TERMINAL BOD^POSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR 
VELOCITY OF GENERATED GAIT INTO VALUES OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM 
OF NEXT STEP, AND DENOTE THE VALUES BY (Xe, Vxe, e be, uM 



V 



BOUNDARY CONDITION ERRORS (errx, errv, err e , err a, ) 
= (Xs, Vxs, ebs,6jbs)-(Xe,Vxe, <?be, wbe) 



DETERMINE INITIAL BOD^fOSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR VELOCITY 
(XO, VxO, e bO, w bO), INITIAL BODY VERTICAL POSITION AND VELOCITY (ZO, VzO), AND INITIAL BODY 
POSTURE ANGLE AND ANGULAR VELOCITY AT ORIGINAL INITIAL TIME 0 



ARE ALL errx, errv, erre b, AND errw 
WITHIN PERMISSIBLE RANGES? 



s / ; N 

~ C LEAVE REPETITION LOOP. ) 

fee[< j» ?eaK 



DETERMINE A PLURALITY OF CANDIDATES (Xs+ a Xs, Vxs, cbs, ZMPrecfeek), 
(Xs, Vxs+aVxs, wbs, ZMPreqwek), (Xs, Vxs, wbs+ A wbs, ZMPrecpeek), ' 
(Xs,Vxs, wbs,ZMPrecpwk+ A ZMPrecHt) IN THE VICINITY OF (Xs, Vxs, whs ZMPrecfeek) 
AND BASED ON THEM, DETERMINE BOUNDARY CONDITION ERROR CORRESPONDING 
TO EACH OF THEM AS DESCRIBED ABOVE. 



pe* |< 



DETERMINE NEW CANDIDATES (Xs, Vxs, w bs, ZMPrecpeek) ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xs, Vxs, wbs, ZMPrecpeek) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. f«*K. 
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V 



DETERMINE NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
ACCORDING TO THE FOLLOWING EXPRESSION. 
q[0] = XO + VxOAoO 



DETERMINE q", WHICH IS THE VALUE OF NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF CURRENT TIME GAIT AND (ZO" VzO") 
WHICH ARE VALUES OF INITIAL BODY VERTICAL POSITION AND VELOCITY OBSERVED FROM SUPPORTING 
LEG COORDINATE SYSTEM OF CURRENT TIME GAIT. 
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FIG.17 
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PROVISIONALLY DETERMINE ZMP CORRECTION PARAMETER CANDIDATE o AND BODY INCLINATION I \/ 
RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE CANDIDATES (ZMPrecpeek, ZMPrecpeekbj. V 



CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL TERMINATING TIME ON THE BASIS OF PARAMETER 
OBTAINED BY CORRECTING ZMP PARAMETER, WHICH HAS BEEN PROVISIONALLY DETERMINED BY 
PROVISIONAL DETERMINATION PROCESSING OF CURRENT TIME GAIT PARAMETER, BY ZMP CORRECTION 
PARAMETER CANDIDATE a, BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE 
PEAK VALUE CANDIDATES (ZMPre^, ZMPrecpeekR AND OTHER CURRENT TIME GAIT PARAMETERS. 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EXPRESSION FROM BODY POSITIONAELOCITY (Xe, Ve) 
AT TERMINATING END OF CURRENT TIME GAIT: 
qO[k] = Xe + Vxe/^0 



DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = qO[k] - q" 



TERMINAL BODY POSTURE ANGLE ERROR 6 berr 
NORMAL GAIT INITIAL BODY POSTURE ANGLE 

- CURRENT TIME GAIT TERMINAL BODY POSTURE ANGLE 
TERMINAL BODY POSTURE ANGULAR VELOCITY ERROR a; berr 

NORMAL GAIT INITIAL BODY POSTURE ANGULAR VELOCITY 

- CURRENT TIME GAIT TERMINAL BODY POSTURE ANGULAR VELOCITY 
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ARE ALL errq, 6> berr, AND aibei 
WITHIN PERMISSIBLE RANGES? 



y — (LEAVE REPETITION G)QP? ) 



DETERMINE A PLURALITY OF CANDIDATES (d+a a, ZMPrecpwke, ZMPrecpeeW») 

(a, ZMPrecpeekfl+ A ZMPreqwefeo, ZMPrecpeekb), AND 

(a, ZMPreqweko, ZMPrecpwkb+ A ZMPreqwett) IN THE VICINITY OF 

(a, ZMPreqweto, ZMPrecpwki), AND BASED ON THEM, DETERMINE ERROR CORRESPONDING TO 

EACH OF THEM AS DESCRIBED ABOVE. 



V 



DETERMINE NEW PARAMETER CANDIDATES (a, ZMPrepeeto; ZMPrecpeekbj ON THE BASIS OF 
(a, ZMPrecpeoko, ZMPrecfeeWH AND ERROR CORRESPONDING TO EACH OF CANDIDATES IN THE 
VICINITY THEREOF. 
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FIG.19 

BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE OF NORMAL GAIT (ZMPrec) 
ONE-LEG SUPPORTING PERIOD ONE-LEG SUPPORTING PERIOD 
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Tm 
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ZMPrecpde ™™ G ZMPrecpeek 
pmK PERIOD jo^K 



FIG.20 

BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE OF CURRENT TIME GAIT (ZMPrec) 

ZMPrecpeekb- 




ONE-LEG SUPPORTING PERIOD 
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